/**
 * File: robot_node.cpp
 * Brief: this node is equat to robot_sensor_node + robot_control_node.
 * Created by: zhangping
 * Created at: 2017.07
 * Modified by:
 * Modified 
 */

#include "ros/ros.h"
#include "robot_control_util.h"
#include "robot_sensor_util.h"

int main(int argc, char **argv)
{
    // Init Node.
    ros::init(argc, argv, "robot_node");
    ros::NodeHandle n;

    // 
    Communication com("192.168.1.1",2001);
    //Communication com("192.168.1.1",2001);

    // Init thread
    robot_node::ControlThread cth( n, com);
    robot_node::SensorThread sth(n, com);

    // Wait thread
    while(ros::ok()){};
    
    return 0;
}

